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== (54) Title: METHOD AND DEVICE FOR ACCURATELY DETECTING ATTITUDE OF MOVABLE BODY 

1= (54) S&3J<Z)*1*: &®t*<Dfttt&g®&my5&&if*<D&m. 

555 (57) Abstract: A method and a 

device for accurately detecting 
information on the attitude of a 
movable body, the device comprising 
a highly accurate attitude detection 
mechanism (1) having, in pairs, 
one rate gyro (2a) for detecting 
the attitude and the other rate gyro 
(2b) capable of providing an output 
inverse to that outputted from the rate 
gyro (2a); the method comprising 
the step of performing a calculation 
processing to mutually offset output 
variations in these both rate gyros. 
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V— h$>W d© F U 7 MaH©SO©»^Sci:b-rt±x 011*. fc^ V— 

bfrb&#£>, i/- hy^f o© h* ^ h^^-r^^io©sp^js-fe>-9-e#: 

l©R®fcJ^ ^a&»fc*tt«Iel4E^am^JinaBS^©^»«ffi«JWM<»W^ 
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m 6 m 5 ia©w»ft«»iftm*i*»©ji#w«**fy^-rs * **w& 
i7^ii, 0 5ig©«»*is»*tH«i«i©flb©^w«^j*^*r^D * 

mi omit, m4<Di%mmmm&mmM*mzfc&ftu-#y h<D-m&m&$i 
mi Halts sii os©i^ii^^m^©*^ : P^^^J^-r§^ny^ 
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mi 3mi±, mi 2 iciiggitttiiioi^M^^^t ?> / d y ^ 
mi sm\±. mi Am^m^m^mmmomw-^m^m^-r^^^^^ 

im&, *%mfc&&mi®ii5mm&m&&mw*mzfci£ifutfy h mmfo 

4a, 4 b©T*8fcJSSS5 SHS*^ £ ^T^^-^.— * 6 a , 6b, 6c^ 
:frbTlS2fcM^L£:£©T*&&o £<£>n^\y h 1= :£ 3 ±IBfl|iBfc 3 CR»fe« 

1 I*n «»tftffl*Si: UTV-hyt'fo2a > 2b*m\ 
*©iSM**IMfctiMJI#l 1 fc£ot\ ^ffoaKy h ©JPffc 3 © HHB^JSjft 
^l^©l5llfil«*tt*llJKfctftm-rs*©T?N ilB-^Clz-b^t^ n2a, 2 

o 

£©©-£\ 1/-F^t^n2a, 2 b >b> £>©&*};£, 
co 1 = + co + co offset 
co 2 = — co + co offset 

2 a, 2 bfc^«&-rSEtt««8©*ttt3<fcSaj*^S»Tf*S« 

*g 2 ia®«i*AM»*ffl*Mii i Ai±, ±e«tt&*»4fcffi4ft* 1 ©*jmm* 
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i/-hywn2a, 2b*^trlSS»BlE»iMfttil«l*lA*K»t* 
©l&ifrmiil 0£flt*.x ±.IB V — h^t-f D2 a, 2 b©ffl*#-^*SP#S* 7 

fc&^-cinn (M) -r^>^hfc«t ^;tx£©m±^tfr£*i^b£:5;?.-£. m 

jffitt 3 © J^SJItflE fcl&ffi £ fi & & ©T- & 2> 0 

£©«-&, A<D«l|:«t31fc«koT»&ftSa* : Vout 

Vout= w 

-CfctK U— h^W D 2 a, 2b©St^U7h^l/->^t^n2a, 2b 
ld#t^t-^IE»«M 1 OO&miz £2>mJl^M} (cooffset) £»IEU ^ISt 

m 3 ia*±s -te» 2 Gg®ff«ift»0iiftffl««i 1 At^fc5iisgittn« 

^lB^IKtttSf- ©Mill 0£ii;?U ±f3l/-h^t^D2a, 2 b© 

ffi;fr#^*j&nJ«*7fc:fe^T:&i]J* (MHO ^tt£>©tB;*7^«j 

Vout= § a> dt 

-T?fc»K l/-fyt^P2a, 2b©SSHU7h^V-b^t^D2a, 2b 

1 0 ©^Sjfc <k£ffi;«l& (^offset) £*fiIEU 

^3m©j«^^8B©^it)Dfc, m4mte7jk-rm<, ^lisct 

&^T^#©^JW@£fT5^ Mlft&IMftffiMt 1 C©IIjJii{:J;oT# 
^>tv?>as^ : VouUi. ±5£©jfc#£flR#bfc %>©£&?>% £©*§-£-&> l' — h 
i/^fD2a, 2 b©SJg F U 7 h^U— h n 2 a, 2 b fc^S&f &1E«J 
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MM 1 0 ©^Hj£cfc£ffi;b^i& (cooffset) £*HIEbs *£frP y h ©JPffc 3 © 

ft*. ^lEJ©^^m^lSA s s H2ia©^JS^ 
&ffl$M£ 1 Aom^-^M^n^WM'd, *tsfrP#y h©BH#3©gSfM§&N 
& fclfcffi f & ^ ^ § & o 

^ 1 C(D&W$!mhmKmmte& ^ *fcfrn>t?y h©flE#:3 ©HI^^J^ J ?>Ial 

H5ia©^Jte0!lfc^ HffSBSg im<D&ft h ©JPtt 3 £0 2 ©H5*jtJg^^fc 

&2>&mW.Bi^®>£ Utiis — M©SD3iJ^-fe>-9- 1 2 a, 1 2b^V\ -€©H 
**Jft£3MfcfcB8M& 1 li-J;oTs ^frD^y h©IH#3©&fira*£7K)fllJftK:lfe 

±fB— M(DmM^>V- 1 2 a, 1 2 h&M\,^\£%.ttfa%KlWLW£^ —^<Dlm 
1 2 afc^fbTflfe^r©SQ5iJ^-fe>^ 1 2 b>fp 5>S^ bfem^J^ftfetv 

^©ilSte^Jfc^frS^fT n^y h §#:©$!*&&. 1 Hl©^-£ri:^& £ 
dSjP&V'*©-^ |2l4 3 ©^i?&SP^^l^---© : ^ : ^^<tbT j e©BteBJ*#ffl§"r §o \>X 

a 1 = + a + a offset 

a 2 = — a 4- a offset 
&£fcB;b*5ffi&o afcfcJil#:3 <Dm$i<D¥-MlmM^ a offsets iSSF 

U ^ h-^JpaiJS-te>1t 12a, 12 bfc#;*&t-3Kl&«Si©&»fc<fc5ffl:fc£i& 

T? o 

mQWommm&mmmmmi ia^ ±flaftiitft&9Mfttutt#i 1 i©»if«i 

aa^Jra^fi-fe^^l 2 a, l 2b©ffl:fcM^©Ml&fcJ;DfT5Ji81$&8BW-r£fc 
»©^>©Ts »P5i^-te>-y-l 2 a, 1 2 b &$feffi|*0&&iftffi4fi*t 1 1A*K 
l&-r^m— ©IE1&«3® 1 0 £tft;ts ±IBin^JR-fe>-y- 1 2 a, 12bOtBMf 
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cc-e, ffijftjft&»ttartltt l lAOlI^Ifaotf f»tb5Hi*: Vout 
Vout= a 

T*£ ^ iP^JS-feVitl 2 a, 1 2bOfi*H'J7b^i6D3ai*'fe> , tM2a, 1 

ill BOiljlli: bT> JpjiJft-fe>^ 12 a, 1 2b©Hi7Ji^OitM^ 
£;|»#-r 5 :^£g&BJ§t-3 . in?t^-fe>-9- 1 2 a , 12 

■humm^yy-i 2 a, 1 2b©ffi7j«^£#n#r^5ii 1 sfc^rjni? -r 

fcfcs 

Vout= S S « dt dt 

SnMt>ij-12a 3 1 2 bOift 1< »J 7 h^JPSft-feV^ 12 a, 1 

* 7 h©*»s* 1 5&— mm.ftx-\z.tz<, -mmfrizTzt, rats 

SjRfl-fcbfcfcOii&tK in5£J^-k>-tf- 12 a, 12 b©?SJK F U 7 h-$> 
iPoiJS-te^lt 12 a, 12 bfcfltf&-r&KI&S« 1 0 (DMWste X Z> &JjmW}*ffi 
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^m^mmM2 1 hvx, ^(D^mw.m^mz-M(DmMm^>^2 2 a, 22 

b&itf— tt<DlNMm j t>y-2 2 c , 2 2d£JBW ^©Jp^jg-te 

^§ £^#1 Jgfcl&ffiT* £ £ £ a b fz © T" & 3 o 
iSISJ^^^fctJ^ 2 lait -McDSn^Jg-fe>^2 2 a, 2 2b#2W;: J K 

^•iqj^fciSM^^ ^fe^*t^^m^2 b^-^-©inatj^'fe>^2 2 c, 

2 2 di?U\,^ZBiMfil%teWW£ti, Pi^Jg^lN&ffi^t 2 1 a , 2 1bl±S 
^£ifi>£bTt£g£*U ^JS^^tB^2 lm^tit^So 

««:«JtJ±, £©i*l»*MMftm*M*2 lfcBu ^P5tJ^-fe>-tl-2 2 a- 2 2 d 
*«**»*K!MftW*l*l 2 1 a, 2 1 b£IEi&lT3i£— ©IE«I«^ 1 0 
> mmm^>V-2 2 a , 2 2b®ttS*if *<ktJ t DDlt-b>^2 2 c, 2 2d© 

tB^i^^s j eti?ixmmmm2 3 &, 2 3hiz&^T%m mm) t&z-tiz 

J;t), ^^^©tB^^Kj-^ K U 7 h^^g^bfeaxTs ^Sl2 4a, 24b 
fc&^T 1 / 2 zmM-WMZft 5 *fcfTP#y h©J3i^3 ©ft 

# fc -r %> ^mm.-&imm&m-% v out-i*5 ± ^ v out^pMj^^m £ n & £ 5 

£©*£\ SPiM-feV-y-2 2 a, 2 2 b©tB*M^-©^l«J^ c fc^Tf#e>tL^AP 
^M-^Vout-lh. #PjiJ^-fe>-9-2 2 c , 2 2 d©tB^j«-^©^«llCcfcoT# 
£ft£JP3£j^K-Vout-2tefc. 

Vout-l= az 

V out-2 = ax 

*k ±mmmizx *p^s-fe>-9-2 2a, 22b, 22c 22 d©?ag 
pj 7 h^>^tie>©iP7tjg-fe>^fc^-r^iEi!imMi oom^mm^miEh, 

±m-mmm^mw.w,m^2 &, 2hi±u^izm$t^xmw£ht^2>tc 
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(Vout) =tan _1 ( Vout-2/Vout-l) 

&T»i*2>o z(D^mf%m^r&, mmm*>y-2 2 a, 22b, 22c, 22 do 

13 1 fc:|3»*3giltfcffi4MSfcU-C\ -^©V-h^t^fD 3 2 a, 3 2 h 
— ^®JP?iJ^-fe>i^3 3 a, 3 3bi5<fcV3 3 c, 3 3 d^ffi^fcl^^bs 
JilB-fcfOl'-h^W nft<»iLSW3HlJftft»*tH«M(t3 la, Jtf3in«J£-te > 

±fBflf*d*S5#'ifetH : »«i 3 1 bi* N -n<Dmmm^>^-3 3 a, 3 3 b#5V> 
fcKttfaSfcBmsftx ffi*iA«&ift£H4Mt3 1 ct±x -*f©iin}lJg?-fe>t>-3 3 

c, 3 3 d#S^fcK#lRl§fc:R1S£*U bfr&s 3ti?>0lSll^ttl±lW 
3 1b, 3 1 c&S^tctt^UTBBe^axfc&OT'&^o — 75\ ^iJ^f^fcB 
ttti$3 1 a fix — *T© V— hS^WP32a, 32 b fcS^fleO £ tCggg^ 
*lfcfc©-efeD> Cin6©W«lfiE»»*ftm«l«l3 1 a, 3 1b, 3 1cfc<fcoT 
ffijftft&gtttitfl*3 1 ifil&l&atiX^Zo 

mi imt±, mi omommm^m^mmms 1 2>m&mm<DMm*m 
m^m^ti^o mfo&ite^ umm^>^3 3a, 33b, 33c, 33 d© 

^D3 2 a, 3 2 b©ffi±M^-^ MSIK 3 6 fc&^X, M Z. fc£SI 3 m id «fc ?) 
j em©^^n-;U7'f 3 5XVa^;^7^^ 3 7 £M 
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LXmnmm3 Sfc^T^JSU ntfy h Jlliifc 3 fclfttH UT 

±fift|ftft«fMfttt4R* 3 la, 3 1b, 3 l cC*^Tl«l*aJ5» 

Mkrfcfc, an own iia©«»je»»*ftaitti«i3 lo^ictftMi 

1 1 ll2©in3ft£-fe>1*-3 3 a~3 3 d©ft;fo*) fc. M£4 

il20OHl^l^ ^ffD^y h©JP#3fcs ^ 5 ©m»ft%«>1ftffl4frK 
4 1 te&tfZ&m&tti^&h bt, -»01/-by + >fn4 2 a, 4 2 b&Stt 
S^t, $j|IIMi4 3. l/-h^t^D42a, 4 2 b fc±IB».HW* 
jf«L3S«fll4 3 £M&^3^jM®mM4 0 itif»ia o T^fT n ^ y 

h©J§^3©Hl^^^>^^^^s H»ftfc^HJt5«fc5fcU"T^5o ±S3 
-^©l/-b^t^D42a, 4 2bi± N SV^M^rft § fc|gg£ fiX U 2> ©(i 

o> 1 = + + co offset 

o> 2 = — co + co offset 
&&fcti;fr#&£o ££T% a)i±JPf*:3 ©m^©IUfe^l^JS> w offset i± K U 
? hi^t'fD 4 2 a, 4 2 b;&VftW*J*&3«#*4 3KMt5*l 

IilI4 0 <D&mte£Z>miJ&MlX$>2>o 

mi3mi±, JBl 2H©**IK*iMftiB«M»4 1 fc:fett*SW&;ffl©»**8ft 
BJi-r 3 £:#>©&©"<:% CD^SE^J-ef*. I/— h^Wn4 2a s 4 2b©tiiiji 
■^©gfttcklK 3*frn#y h©IF0#3 ©mte^MJ^^^J^^ffi-r^ «k ^ ^ 

jyfcftfc:^ V-hS>Wn4 2a, 4 2b©ffi^M^^ fjiW^IMSWI 
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4 3l3:fcV^ ^ft^axD/ArJ WC— * 4 4 a, 4 4 b^lt JD#Ii 4 5 (I 
fc^TinJ* mm U tt*£*4 6fc::}3^T 1/ (2xDAGain) 

_fcfBi/-h^^-rn4 2 a, 42b®tUA^ ftJI^II^S^ 4 3 izM D 52. 

DAo) 1 = DAGain x ( + co + a> offset) + DAoffset 
DAo> 2 = DAGain x ( — a> + co offset) + DAoffset 

DAGainJ±fi»^IM3I»i 4 3 T'Om D 52.^^-1' >> DAcooffsetfct 
^ilIK»ttM4 0©^UlfcJ:^T^-r§DAr2>^-^OS^Sffi^a&^fc^ 

JM3$Mf 4 3©ft^JM31£J;oT#£ftSffi;b : DAout 

DAout = <w 

ffc 3 CD IHte^3tJg^^<fe & £ £ £ & o 

frn^y Yvmfcsv&mn^ 7izmmzifcmT%mm*Mm i irz>z.£&x*%2> 

o 

|1 2EiCD^^m^lS^D3lJS-fe>itT-$>oT^ M^^^M^t 4 
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ms i cp^m^km^mt b-r. — nvrnm^y-v-s 2 a, 5 2 b;&t>*— *j-©jp 

IN&tBWi5 la, 5 1bfc<tots ^fr nstfy h (D^^3 ©^fHf#S> Hffcift 

±13— ^T©iP3iJg-fe>-9-5 2 a, 5 2 hRXJP— ttomM^ >V 5 2 c , 52d 
*#^S*»flE*tMftffi***5 la, 5 1 b 3 £:#fc\ MP«#ftIi31ttttt 

5 3. ^^_hfBJnjtJg-fe>iti:$iJ#^^aaa5 3 £IKft"r£&5SiRS&«® 5 
0£ii;U _hlB— *f©iP?tJft-fe>1?-5 2 a, 5 2 b jfiM^tzRttfa # fcRS£ *x 
. — M®m&& J te>y- 5 2 c , 5 2 d &S.^te%.ttfa%lzmW£ti, ^tb^fci 
oT«t^**t»l»»ft*iSrtftiH*l*5 1 a, 5 1 biJSS^tlfi^bT^g^tLT 

H 1 5ia«ix ^1 4H©«»««»*ffl«liB lfc*W-S«l«*l|E«ka*W(l5 

ft]j»ft-fe>-tf-5 2 a, 5 2 b ©ffl*M^*ft«J«I»#«Iia«*lt 5 3 IclRD 
^*b&©|iailfc«koT^6tbSief3»Jft*:*n5*JS^DAout-li:. ftD&ft 
t>t52c, 5 2 d©tH*«-§-*«UtW»l¥«L3S«MS5 3 ^Kfe 

HffcWfcfc^ MfflSIJ*^S««5 3 fcl&MTs iP«K-fe>^52a, 52 b© 
i±S*®-^^^tV^nD/A=i>^-?— ^ 5 4 a, 5 4 b^^T^P#^^5 5 afc:fe 
^TDUM- mW) U 5P^Jg-fe>1^5 2 c, 5 2d©ttlM^^tl^tL 

D/A3WW5 4c, 5 4 d£*£TSnJ«*5 5 hlz&^XtinW b 
fe^^^s 8lj*gJfc5 6 a;RV5 6 bfc:j3V>T N * tl & 1 / ( 2 x D AGain) 
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zom-Ss mmmmsvs 2 a, 5 2 b§wiijii«i5 3 

DAout-l= az 

-e&t>> in^s-fe>^5 2c, 52 azmffimmmmmms 3 £&D&^itF#L 

VAout-2= ax 

in?SJg-te>it5 2a-52 dCDMJg KU7b % **b£><DinJi*-fe 
fc-ffc*&-r3iEi&«ffi©&ttx ^ e>fci±iD7tJS-fe>-y-5 2 a~5 2 d £*!Hfil$S$*#L 
34MI5 3 £#&©#M;»S©5 0©&»«c£oT»£^S©Jffl*iras«« 
5 3 |*)T-©^l&b U 7 b^MjEUs ^Jgi-^fTD^y b©JPi£3 ©iPjtJgaz 

— tt<DmM&t>y-5 2 a, 5 2 bfcx — ^■OiPJiS'fe>"^5 2 c , 5 

#131 £ ftfcSJfltftaoaBft-fe >^M^DAout-l£^»MPiiJg-te >i^fs-^DAout-2 

8 lil > 

(DAout) =tan _1 (DAout-2/DAout-l) 
©SftJ^fcitK iJP^S-fe>^5 2 a~5 2 d®^F'J7 b. -^ft S> ©flP?tft-fe 

|J7 b£«IEU ^Jftfc^fxD* y b©BB#:3©#fl?J&&^£#»a£i:a s 
S&tg©*!^-?!^ BJE#©tH¥*Scfc«t *K 7S*Sfit^fTn^y b©i@ 
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© res& ^ e» s tt s «t -5 1: u t v ^ s © Mm jtAHStMt ciD^ft^© 
^^je^^#^^©^^^^fc^J^fr-5^^^^Jffl-rs©^7Sb 
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